#include "motor.h"
#include "ultrasonic.h"

//电机初始化
void motor_init (void)
{
	set_gpio_out (buff4_11, "0");
	set_gpio_out (buff5_12, "0");
	set_gpio_out (buff5_13, "0");
	set_gpio_out (buff5_14, "0");
}

//电机正转
void motor_r (void)
{
	set_gpio_out (buff4_11, "1");
	usleep (10000);
	set_gpio_out (buff4_11, "0");

	set_gpio_out (buff5_12, "1");
	usleep (10000);
	set_gpio_out (buff5_12, "0");

	set_gpio_out (buff5_13, "1");
	usleep (10000);
	set_gpio_out (buff5_13, "0");

	set_gpio_out (buff5_14, "1");
	usleep (10000);
	set_gpio_out (buff5_14, "0");
}

//电机反转
void motor_l (void)
{
	set_gpio_out (buff5_14, "1");
	usleep (10000);
	set_gpio_out (buff5_14, "0");

	set_gpio_out (buff5_13, "1");
	usleep (10000);
	set_gpio_out (buff5_13, "0");

	set_gpio_out (buff5_12, "1");
	usleep (10000);
	set_gpio_out (buff5_12, "0");

	set_gpio_out (buff4_11, "1");
	usleep (10000);
	set_gpio_out (buff4_11, "0");
}

